Modern Robotics, Chapter 4: Forward Kinematics Example